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1. INTRODUCTION 

Initially, robots are designed with an idea of developing a mechanism to replace/support human when 
interacting with the environment [1-4]. Along with the speedy evolution of control engineering, computer 
science, and mechanical technologies, robots have an inclination toward possessing the human form [5-7]. One 
of the earliest humanoid robots but currently attracted researcher’s attentions is a dual arm manipulator [8]. 
In comparison to a single arm manipulator, the dual arm manipulator is capable of handling sizable objects, 
objects that having a certain degree of flexibility, and assembling mechanical parts [9]. In recent years, with 
the development of modern dual-arm robots (DAR), this concept becomes more and more important for the 
automation of processes in the life sciences [10]. Due to the human-like structure of the robotic arms, it can 
used for a wide number of application. 

Various applications of in automatic measurement field in [11-13]. The other applications are also 
used in industrial manipulation tasks for performing automatic assembly operations [14, 15], or using for 
automation of cell production system for cellular phones [16]. Primarily designed to work in coordinated 
operations, the dual arm manipulator suffers from inherent kinematic and strong dynamic couplings. The phe- 
nomenon poses a challenge in dual arm manipulator control problems. The situation become even worse when 
the bi-manual manipulator holding a rigid object due to the formation of closed kinematic chains. Individual 
arms are dynamically engaged through the manipulated object, thus in coordinated modes, two arms operate in 
constrained motions. This leads to a requirement of complex control schemes that can handle the manipulator 
and object dynamics. Various control methods have been developed for the . Classical algorithms as X.Yun at 
el. [17] apply nonlinear feedback techniques approach, N. Sarkar at el. [18] propose control scheme integrates 
hybrid position/force control and vibration suppression. In paper [19], a fuzzy force control framework is 
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proposed for dual-industrial robot systems. Besides, there are also many researches consider adaptive control 
algorithms for the . Zhi Liu at el. [20] use an adaptive neural control scheme to deal with the problem of 
output hysteresis. N. Yagiz at el. [21] develop a sliding mode controller to investigate the performance of two 
coordinated planar arms in transporting a load to its new location with friction-assisted handling. In [22], the 
authors propose a sliding mode control combined with a parameter estimator for the robot system. The result 
show a practical approach since many parameters are not convenient to measure. In this study, we develop a 
generalized model for model with 2n degrees of freedom and introducing a control approach for trajectory 
tracking using super-twisting algorithm. The feasibility of the control is confirmed using the 4 DoF model 
to numerically investigate tracking quality and the adaptability to the disturbance of the super-twisting sliding 
mode controller. 


Di MATHEMATICAL MODEL 

The configuration of model consisting of two planar arm robot that is shown in Figure 1. Each arm 
robot is composed of a set of links connected together by revolute joints. In this study, the model with 2n 
joints is assumed through that all joints have only a single Degree-of-Freedom (DoF). With the i*” joint, we 
associate a joint variable, denoted by 0;. Additional, m;, l;i, Li represente the mass, mass moment of inertia 
and length of related links, respectively. The mass of load is denoted by m(t), and , d1, d2 denote the width of 
the rectangular load and the distance between the bases of the robot arms.There is viscous frictions acting on 
all of the joints denoted by b;. 





Figure 1. model coordinates 


The forward kinematic problem is to determine the position and orientation of the end-effector, given 
the values for the joint variable of the robot. To perform the kinematic analysis of 2n links model, we represent 
used Denavit-Hartenberg conventions that can be referred to [23]. By using the generalized frame oxyz which 
is shown in Figure 1, the kinematic equations of right arm robot are 


d 
£n = Lı cos(01) + La cos(01 + 02) + ... + Ln cos(01 + 02 + ... + On) + 
) 


(1) 
Yn = Ly sin(@ ) F Lo sin(0ı F 02) e aaa F Lna—1 sin(0ı a2 Ao Ae ase oe On 
Kinematic equations of left arm robot in the generalized frame oxyz are 
dy 
Lan = Ln41 cos(On41) + Ln4e2 cos(Ongi1 + On+2) +... + Lon cos(On41 + Onto +... + Jon) - >, 
Y2n = loai sin(@,41) F Loasa sin(On41 =e 6n+42) af eT Lon sin(On41 J On+2 Aa T Oon) 
(2) 
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(a) When the load at fixed position (b) When the load at fixed position 


Figure 2. Representation of forces, (a) When the load at fixed position and (b) When the load at fixed position 


Where as the kinematic equations describe the motion of the robot, the dynamic equations explicitly 
describe the relationship between force and motion. Firstly, we concerned about the term of dynamic which 
handling the load. Representation of forces acting on load is illustrated in Figure 2 (a). Where F1, Fa are forces 
of right arm, left arm tips to the load. The friction forces Fsı Fs2 and their components Fsiry, Fs2gy, Fs1z, 
F’,2, between the arm tips and the load surface. The force F1, Fo can be write in frame oxy as 


Fig = -picos p = Fays mny; fy = —P, sing + Fsigy COs Y 
Por = Fo cosy — Fs2rysin yp, Foy = fosiny + Ferny COSY (3) 


Next, we used the Euler-Lagrange equations to derive the dynamical equations in the n-link robot. Following 
[23], the motion equation of model in matrix form as 


D(q)q+ C(q,4)a — g(q) =7 (4) 


when the robot perform the transportation, the motion of robot can be effect by external disturbances, viscous 
friction forces and load torques. The motion equation of model after handling the load were given as 


D(q)a + C(q,q)a—g(q) = T +m -w - p (5) 
where state variables q = [61, 02, ...,92n]" 3 To is the load torque ; w, 3 is 2n x 1 vectors represent for the 
external disturbance torques and the viscous friction forces, respectively. We specified as 


= n 
W = [W1,W2,..,Wan| , B= (b161, baġ2, bonban | (6) 


3. CONTROLLER DESIGN 
3.1. Sliding mode controller 
The state space form of model with joint variables q = [01, 02, ..., Pan 


q = D(q)*[7. — w — 8 — C(q, 4) — 2(q)] + D(q)*7 (7) 


|£ can be written as 


The state space form of model can be rewritten as form of a non-linear dynamic system 


t = f(x, t) + B(x,t)u (8) 


Where the state variables in the state space x € R4”, x = |q, ġà]! = [01, 02, ..., 02n; 61, O2..., Oan]7 
The state equations without the control inputs f (x,t) € R4”, f(x, t) = 01, 02..., Oon, fi, fa, ---, fon|* with the 
component |f1, f2, ---, fon] = D(a) tū — w — 8 — C (q, d) — g(q)]. Meanwhile, u € R?” is generalized 


torque input vector and B = [zeros(2n), D(q)|’ € R*"*?" is the elements of which are the coefficients of the 
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generalized control inputs in the state equations. With A(x) = x, — x are the difference between the reference 
value and the system response. We define the sliding surface in the state space form as 


s=(G]A(z) = [Glle 4" (9) 


` 0 0 0 1 0 0 
0 à 0 0 01 0 0 
[G] = (10) 
0 0 0 00% 0 
0 0 0 àm 0 0 0 1 


In sliding mode controlled systems, the control input is changed to drives, and maintains the system 
states on a sliding surface[24], [25]. Therefore, consider the control law u= ueg (s = 0) 


un (s #0) 
Where the equivalent control we, is the value the switched signal to maintain sliding, and which is 
formally obtained as the solution to the algebraic equation s = 0 when s = O, must satisfy 


$= |G]tr — [G]|[f (x,t) + B(x, t)ueq] = 0 (11) 


ueg = [GB(2, H] [Gir — Gf (x,t) (12) 
Let define Lyapunov candidate function has to be positive definite V (s) = sT s, To drive x reach the 


sliding surface the wy signal have to make sure V(s) = s'§ < Ofors #0. Therefore, uy = Ueg + A we 
have 


8 = |Gl¢, — [G][ f(a, t) + Bla, t) (ueq + A)| (13) 
= —|G]B(z,t)A =0 (14) 
If we denoted that s = —|K|sign(s) with 

ky O 0 0 

0 kao 0 0 
[A] = ; (15) 

0 0 >» 0 

Lo 0 0 hon 

A = [GB(z, t)]~*[K]sign(s) (16) 


Combining with (12), the total control input is found by 


u = [GB(z,t)]~'[Gz, — Gf (a, t) + [K]sign(s)| (17) 


3.2. Super-twisting sliding mode controller 
The sliding set of order r defined by s = 6 = § =... = s‘"—)) = 0. The first-order sliding mode tries 
to keep s = 0, second-order sliding mode verified s = § = 0. We purpose [21, 22] = [s, 8]’, the problem of 


second-order sliding mode is reduced to the stabilization in finite time of the auxiliary system as below 


Z1 = £9 
18 
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Where, 


ðs O8 
PAE a Fp RR (19) 


Os 
y(x, t) = 9, Pe t) 


The super-twisting algorithm to stabilize the robot manipulator requested that for some positive constants 
q, C Kı, Ko, U, and, 


euko ea 126240 Se, a Sarees 


The super-twisting sliding mode controller is given by 


Usw = —Brv/|Z1|sign(21) + uz (20) 


f=. a 20) 
asign(z,) (|u| < U) The effective control signal u for super-twisting algorithm consists of two terms: u = 
Ueq + Usw- Similar sliding mode controller, weg is equivalent control signal that guarantees s = s = O or 
s+ As =0. 

IG|z, — [G][ f(a, t) + B(x, t)ueg| + As = 0 (21) 


leq = [GB(a, t)|~'([Ga, — Gf (a, t)] + As) (22) 


The term of usw is control signal of super-twisting algorithm. Hence, combining (20) and (22) the super- 
twisting algorithm have the control input 


u = [GB(z, t)|~1((Gz, — Gf(x,t)] + As) — BV Jzi|sign(z1) + u1 (23) 


4. RESULT AND DISCUSSION 
4.1. Trajectory planning 

To illustrate the effectiveness and applicability of super-twisting sliding mode controller, we design 
the super-twisting sliding mode controller for model with four DoF (n = 2), and simulation results are 
compared with conventional sliding mode We used point-to-point motion for the trajectory planning, which 
is specified initial and final configuration of end-effector. In this case, the inverse kinematic solution must be 
used to convert end-effector configuration to a sequence of joint configurations. The reference trajectories are 
given by 


s(t) = sp + (zaaf)? y(t) = yr + (ya —yfl)e 
ta y= Tf2 + (£i2 — oe yo(t) = Yf2 + (yi2 — y(f2))e 1 


Where x1(t), yi(t), v2(t), yo(t), are the reference trajectories of right arm and left arm robot; 
Til, Yil, Lig, Yi2, are the start positions, £f1, Yf1, Tf2, Yf2, are the destination positions. Each periods, the 
robot represents the amount of time t = 2s. In last period reach to the final configuration, the robot must to 


rotate y = —(7/4) + (a7/ 4)e7 10-4). Hence, the reference trajectories in this period t = 4 —> 6s is 
ee. ey ee 

y(t) = Sm + (fi —Bm)e** + E goso GS Y E = E + sin g 
Ze 2 dy 2; 2 dy ; 

z2(t) = Im + (Lig — Lm)e Tt > cosy yalt) = Ym + (Yiz — Ym)e oe > Sın Y 
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4.2. Numerical simulation 

From Figure 3(a), we can see that, both the basic sliding mode controller and super-twisting sliding 
mode controller solve successfully the problem of trajectory tracking. The actual value of the rotation angle at 
the joints are very closely track to the reference value. Besides, we also find that the quality of super-twisting 
controller is better when the maximum deviation angle at joints is only about 0.4 x 10~%rad, while in sliding 
mode controller is about 0.9 x 10~%rad. The value of rotation of the object respect to the oy axis in both 
controllers is very close to the set value. In the period from O to 4 seconds this deviation angle is equal to 0 
degrees, and starts from the 4th second onward. The object begins to rotate with the trajectory as described 
in above, until the end of the cycle at the 6th second the object’s rotation angle respect to Oy is 45 degrees. 
The deviation made by the basic sliding controller is clearly larger the deviation made by the super-twisting 
sliding mode controller. 
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Figure 3. The reference and the actual joint angles, (a) The reference and the actual joint angles, 


(b) Error tracking of the joint variables 


The Figures 4 (a) and (b) depict the torque of joints and the interaction forces between the robot 
arm and the object, respectively. The control torque signals as well as the interaction forces from the basic 
sliding mode controller are greatly vibrated (chattering), while in the super-twisting sliding mode controller, 
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the vibration range and vibration amplitude are very small. Also from the simulation results we see that the 
force acting on the object is match with the requirement to move the object according to the trajectory. From 
second to 4th second, force Fz is greater than F to move objects from left to right; the forces Fsizy and Fs2ry 
are equally assured so that the object does not rotate in the direction of o, because at this time the object is 
moving in parallel with the o, axis. From the 4th to the 6th seconds, during this period the object is rotating 
so that the forces Fsizy and F's27, are no longer equal. Summary, in the absence of noise, the quality of the 
super-twisting sliding mode controller is better than the basic sliding mode controller. We assume the noise 
signal is a function of time w = [sinlOmt sin207t —sinl0mt —sin2O0mt]’. It can be seen that both 
controllers are affected by noise, especially in the basic sliding mode controller, when the noise appears, the 
vibration amplitude and frequency of the control torque signal and the interaction force also increase. For super- 
twisting controller, the effect of noise is much smaller than the basic sliding mode controller. In general, both 
two controllers response well to the the requirements of trajectory control. However, in terms of chattering 
reduction and feasibility in practical, the super-twisting sliding mode controller will be more dominant than 
the basic sliding mode controller as shown in Figure 5 and The numerical simulation values can be found in 
Table 1. 
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Figure 4. Control torques and interaction forces, (a) Torque control of the joints, 
(b) Interaction forces 
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(b) Interaction forces 


Figure 5. Result simulation with uncertain disturbance torque, (a) Error tracking of the joint variables, 
(b) Interaction forces 


Table 1. Simulation parameters of model 
mı = M3 = 5(kg) Lı = L3 = 0. 5(m) d2 = 0.4(m) bı = b2 = b3 = b4 = 100(Nms) 
mə = m4 = 4(kg) Lə = L4 = 0.4(m) dı =0.2(m) Mioad = 0.5(kg) 
I, =I3 =0.1(kgm?) kı = k3 = 0.25(m) p=03 g = 9.8(m?) 
I = I4 = 0.08(kgm?) Kə = K4 = 0.2(m) 


5. CONCLUSION 

The paper successfully built a generalized model for model 2n degrees of freedom. According to 
an analysis of the numerical results, the super-twisting sliding mode controller shows adaptability external 
disturbances, trajectory tracking while the robot handling and transportation the object. Furthermore, the 
super-twisting sliding mode controller has restricted significantly chattering phenomenon which is the diffi- 
cult problem of the basic sliding mode controller. 
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